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Abstract 

This  paper  presents  an  adaptive  actuators  allocation  scheme  that  is  fault-tolerant  with  respect  to 
actuator  faults  or  loss  of  effectiveness.  The  main  idea  here  is  to  use  an  ad-hoc  online  parameter 
estimator  coupled  with  an  allocation  algorithm  to  perform  on-line  control  reconfiguration.  Two 
simple  algorithms  are  proposed  for  nonlinear  discrete-time  systems.  The  main  properties  of  the 
algorithms  are  summarized  in  the  disturbance-free  case  and  their  effectiveness  shown  by  means 
of  two  numerical  examples. 


1  Introduction 

Actuators  redundancy  is  an  important  issue  to  deal  with  in  increasing  the  fault-tolerant  and  control 
properties  of  many  real  systems.  For  example,  it  is  a  very  common  matter  in  (autonomous)  vehicle 
applications  due  to  safety  and  performance  reasons.  A  traditional  way  to  handle  overactuated 
systems  (i.e.  systems  with  physical  actuator  redundancy)  is  the  use  of  optimal  control  design 
[1].  Such  an  approach  achieves  both  regulation  and  control  distribution  amongst  actuators  at 
the  same  time.  A  different  approach  consists  in  using  a  (simpler)  control  law  that  specifies  only 
the  total  control  effort  that  has  to  be  produced  and  in  separately  solving  the  so-called  Control 
Allocation  Problem  (CAP)  i.e.  the  one  of  optimally  distributing  the  desired  total  control  effort  over 
the  available  actuators.  Due  to  its  relevance,  especially  in  flight  control  systems,  CAP  has  been 
deeply  investigated  in  last  decade  and  several  methods  have  been  proposed:  Daisy  Chaining  [4], 
Direct  Control  Allocation  [2],  Convex  Optimization  Based  algorithms  [5]- [11]  and  Pseudoinverse- 
Redistribution  (PIR)  methods  [12]- [13]. 

One  active  area  of  research  in  overactuated  systems  is  how  to  exploit  their  physical  redundancy 
to  develop  effective  reconfigurable  control  strategy  so  as  to  avoid  or  at  least  mitigate  the  effects 
of  actuator  failures.  A  popular  way  to  ensure  some  level  of  control  reconfiguration  is  the  use  of 
adaptive  control  laws  [14]- [16].  An  alternative  approach,  that  will  be  investigated  here,  is  the  so- 
called  Reconfigurable  Control  Allocation  (RCA)  problem  [17]- [19] .  The  key  idea  is  depicted  in  Fig.  1 
where  supposedly  the  control  law  has  been  designed  on  the  basis  of  a  virtual  system  with  a  minimal 
number  of  inputs  v{t).  It  is  assumed  that  the  virtual  inputs  are  fully  equivalent  to  the  physical 
inputs  u[t)  in  generating  a  desired  control  effort.  Then,  an  allocation  unit  distributes  at  each 
time  t  the  control  v(t)  on  the  physical  actuators  u(t),  with  a  law  that  is  allowed  to  be  time- variant. 
Therefore,  in  the  case  of  actuator’s  faults,  control  reconfiguration  is  possible  in  many  cases  by  simply 
modifying  the  distribution  of  the  total  control  effort  v(t)  to  the  remaining  no-faulty  actuators  in 
u(t).  This  does  not  perturb  in  principle  the  closed- loop  system  dynamics  because  there  are  several 
way  to  distribute  the  control  amongst  actuators,  all  of  which  making  the  system  behaving  in  the 
same  way. 

In  this  paper  a  preliminary  adaptive  control  allocation  scheme  is  proposed  able  of  solving  RCA 
problems  for  non-linear  discrete-time  systems.  Such  systems  are  subject  to  actuator’s  faults  or  loss 
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Figure  1:  Control  structure  with  allocation  and  control  performed  separately 


of  effectiveness.  Unlike  other  works  on  the  topic,  here  the  algorithm  is  not  assumed  to  know  the 
occurrence  of  a  fault.  On  the  contrary,  an  adaptive  mechanism  is  used  to  estimate  possible  loss 
of  effectiveness  and  make  the  on-line  computation  of  the  allocation’s  rules  possible  by  solving  a 
standard  constrained  QP  problem. 

The  main  properties  of  the  scheme  are  summarized  and  some  indications  on  how  to  ensure 
persistence  of  input  excitation  are  given  in  order  to  ensure  good  estimation  properties.  For  simplicity 
all  development  is  done  in  a  disturbance-free  scenario  without  considering  model  uncertainty.  All 
issues  related  to  the  robustness  properties  of  the  algorithm  are  demanded  to  future  studies. 

The  paper  is  organized  as  follows:  the  problem  is  stated  in  Section  II.  In  Section  III  an  adaptive 
allocation  scheme  is  presented,  two  different  algorithms  are  proposed  and  their  properties  summa¬ 
rized.  Finally,  two  numerical  experiments  are  reported  in  Section  IV  and  some  conclusions  end  the 
paper. 

2  Problem  statement 

2.1  Control  Allocation  Problem 

Let  us  consider  plants  whose  dynamics  is  described  by  the  following  nonlinear  discrete-time  state 
space  equation 

x(t  +  1)  =  a(x(t))  +  Bu(x(t))u(t),  (1) 

where  x  £  TV1  is  the  state  vector  and  u(t)  £  lZm  the  control  input;  a(x)  £  1Zn  and  Bu(x)  £  'JZnxm 
are  nonlinear  state-dependent  functions.  The  following  assumptions  are  considered 

1)  The  matrix  Bu(x)  is  column-rank  deficient:  Rank(Bu(x ))  =  k  <  m,  Vx; 

2)  The  input  signal  u(t)  lies  into  a  compact  set  P,  i.e. 

u(t)  £  P  :=  {«  £  7 Zm  |  u~  <  u  <  w+}  ,  (2) 

where  u~  :=  uf,...,  «„]T  £  lZm  and  u+  :=  [u^,  u ■  ■  ■ ,  u+]T  £  7Zm. 

The  assumption  1)  (rank  deficiency)  allows  one  to  define  an  equivalent  representation  of  the  plant 
(1) 


x(t  +  l)  =  a(x(t))  +  Bv(x(t))  v(t),  (3) 

By(x(t))v(t)  =  Bu(x(t))u(t),  (4) 

where  Bv{x)  £  'JZnxk  is  a  full  column-rank  matrix  such  that  its  columns  are  a  basis  for  the  subspace 
defined  by  the  columns  of  Bv(x)  and  v(t)  £  7 Zk  is  the  virtual  control  input.  Hereafter,  the  state 
space  equation  (3)  will  be  referred  to  as  the  virtual  plant  while  (4)  the  parity  equation  of  the  system, 
which  defines  the  analytical  relationship  between  the  virtual  and  applied  commands.  Note  that,  in 
such  a  scheme,  the  virtual  control  input  v(t)  represents  the  desired  total  control  effort  we  want  to 
apply  to  the  plant.  In  the  sequel,  we  will  assume  that  such  a  signal  v(t)  is  provided  at  each  time 

instant  by  the  control  law.  On  the  basis  of  the  overall  system  description  (3)- (4)  under  the  actuator 

constraints  (2),  the  following  problem  can  be  stated: 
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Control  allocation  problem  (CAP)  -  Given  a  virtual  input  v(t)  £  TZk  compute  a  command 
input  u(t)  £  lZm  such  that  (2)  and  (4)  are  satisfied. 

Such  a  problem  has  been  extensively  studied  in  recent  years  and  several  numerical  procedures  for 
its  solution  have  been  proposed  ([4]- [13]).  Note  that: 

•  Many  previous  works  on  the  topic  re-arrange  the  equation  (4)  as  follows 

v(t)  =  B(x(t))u(t)  f) 

Bu(x)  =  Bv(x)B(x) 

where  B(x)  £  pikxm  js  a  factorization  of  Bu(x) 

B(x)  =  (B^(x)Bv{x))~1  B^(x)Bu(x).  (6) 

•  The  CAP  could  not  admit  any  solution  due  to  the  actuators  saturation  constraints  (2).  In 
such  a  case,  the  CAP  can  be  relaxed  by  requiring  to  compute  a  command  u(t)  such  that 
Bu(x(t))u(t )  is  somehow  close  to  Bv(x(t))v(t)  (e.g.  by  evaluating  at  each  time  instant  the 
numerical  value  of  || Bu(x(t))u(t)  —  Bv(x(t))v(t) ||); 

•  The  analytical  redundancy,  i.e.  Rank(Bu(x ))  =  k  <  m,  implies  that  in  principle  there  exists 
a  set  of  admissible  commands  u  solution  for  the  CAP.  This  fact  can  be  exploited  to  comply 
with  other  specifications  besides  the  CAP  requirements. 

A  common  way  to  solve  CAP  at  time  t  is  that  of  minimizing  the  quadratic  optimization  problem 

^)  =  argmin||s||^  +  ||u|||u, 

Bv(x(t))v(t)  =  Bu(x(t))u  +  s,  (V 

u  E  fl. 

The  slack-variable  s  is  used  to  enlarge  the  set  of  solutions  in  the  parity  equation  (4)  and  it  allows 
the  achievement  of  approximating  allocation  rules.  When  zero,  a  perfect  allocation  is  achieved.  On 
the  contrary,  the  penalty  on  u  is  optional  and  it  is  used  to  minimize  the  actuators’  effort  or  to 
impose  some  preference  when  many  solutions  are  possible. 

It  is  well-known  that  an  explicit  solution  to  this  optimization  problem  can  be  found  in  the  uncon¬ 
strained  case  while  it  does  not  exist  in  the  general  case.  However,  in  order  to  reduce  computational 
burdens,  several  efficient  algorithms  based  on  the  senri-explicit  solution  have  been  proposed  in  the 
last  years  (see  [11]- [13]).  For  the  purposes  of  this  paper,  it  is  important  to  notice  here  that  compu¬ 
tational  efficiency  obtained  through  explicit  approaches  is  paid  in  term  of  a  reduction  of  flexibility 
w.r.t.  reconfiguration  issues  (see  [11]). 

2.2  Fault  Modeling 

For  simplicity  we  will  restrict  our  attention  on  the  class  of  faults  describing  actuator  effectiveness 
variations.  The  effect  of  a  fault  event  is  then  to  change  in  percentage  the  nominal  gain  of  some 
actuator  signal.  Such  a  kind  of  fault  can  be  naturally  formalized  in  a  multiplicative  fashion.  Additive 
effects  will  be  considered  in  a  future  work. 

x(t  +  1)  =  a(x(t))  +  Bu(x(t))A(t)  u(t),  (8) 

where  A (t)  =  diag  (Ji(i),  ^(t), . . .  ,5m(t)}  is  the  so-called  Effectiveness  Matrix  and  5i(t)  £7 Z,i  = 
1, ...,  m  are  piecewise  constant  sequences  representing  the  effectiveness  of  any  single  actuator.  Notice 
that,  in  absence  of  fault  occurrences,  A (t)  =  I.  Moreover,  the  parity  equation  (4)  becomes 

Bv(x(t))v(t)  =  Bu(x(t))A(t)u(t).  (9) 
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Then,  the  problem  we  want  to  solve  can  be  stated  as  follows 

F  -  Tolerant  Control  Allocation  Problem  (F-TCAP)  -  Given  the  virtual  plant  (8)  and 
a  virtual  input  v(t)  £  TZk,  find  a  command  input  u{t)  £  7 lrn  such  that  (2)  and  (9)  hold  true. 


3  A  two-step  procedure 

It  may  simply  be  observed  that  the  knowledge  of  the  Effectiveness  Matrix  A (f)  makes  F-TCAP 
to  be  reduced  to  a  more  simple  CAP.  This  allows  us  to  propose  the  following  adaptive  two  steps 
method  to  solve  F-TCAP  at  each  time  t: 

Step  1:  Compute  the  diagonal  matrix  A(t),  the  best  estimate  of  A (t)  at  time  t,  based  on  records 
of  N  past  system’s  measures. 

Step  2  :  Solve  the  CAP  defined  by  (2)  and  (9)  by  assuming  (certainty  equivalence  hypothesis) 

A(t)  =  A  (t), 

There  is  an  huge  amount  of  literature  both  on  online  parameters  estimation  and  allocation  prob¬ 
lems.  Many  of  the  existing  algorithms  solving  the  two  problems  can  be  arranged  in  this  general 
scheme. 


3.1  A  simple  two-step  algorithm 

Hereafter,  a  very  simple  two-step  algorithm  is  proposed  by  using  quadratic  programming  arguments. 


Step  1:  -  Estimate  of  A(t) 

In  order  to  estimate  the  Effectiveness  Matrix  it  is  convenient  to  rewrite  things  in  terms  of  the 
increment  matrix 

f  (t)  A  A(t)  -  A(t  -  1)  (10) 

defined  as  the  diagonal  matrix 

f  A  diag{ 71, 72,  ■  •  • ,  7m}  G  hi"1 

of  loss-of-effectiveness  actuator  increments  7 *(f)  =  Si(t)  —  5i(t  —  1),  i  =  1,  ...m. 

We  are  especially  interested  in  algorithms  able  at  detecting  constant  or  slow-varying  actuator 
faults  or  loss  of  effectiveness,  that  is  in  determining  matrices  A(f)  that  ’’matches  as  much  as  possible” 
the  measured  signals  of  the  plant  in  the  last  N  time  instants,  with  N  arbitrarily  chosen.  This 
corresponds  to  solutions  which  minimize  the  entries  of  17  In  principle,  such  a  strategy  corresponds 
to  the  sequential  solution  of  the  following  two  least-squares  problems: 


N 

§i(t)  =  argmin^  ||»i||^ 
si,r  i=1 

x(t  —  i  +  1)  —  a(x(t  —  i)) 

—Bu(x(t  —  i))  T  +  A(f  —  1)  u(t  —  i)  =  Si,  i  =  1, 


(11) 


,N 


and,  once  Si(t),i  =  1 , ,N  are  obtained, 

f(t)  =  argmin  ||vect(r)|||j 


x(t  —  *  +  1)  —  a(x(t  —  i)) 

-Bu(x(t  —  i))  r  +  A(f  -  1)  u(t  -  i)  =  §i(t),  i  =  1, 


(12) 


,N 


where  vect(T)  =  [71, 72,  •  •  • ,  7 m]T  G  Tlm  and  Si  £  hln ,  i  =  1, . . . ,  N  slack  vectors  and  R  =  R'  >  0 
and  Qi  =  Q\  >  0,  z  =  1 , ...  ,N  consistent  weighting  matrices. 
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The  choice  of  N  has  an  important  role  in  such  a  computation:  picking  a  small  value  of  N  it 
means  having  few  or  no  information  at  all  and,  in  turn,  bad  parameters  estimation  results.  On  the 
contrary,  a  large  value  of  N  gives  rise  to  long  computation  and  reconfiguration  times.  A  reasonable 
choice  is  m/n  <  IV  <  2m. 

From  a  practical  point  of  view,  an  approximate  numerical  solution  to  (11)  and  (12)  can  be 
obtained  by  combining  those  two  optimization  problems  into  a  unique  mixed  weighted  least-squares 
problem 


N 


T(t)  =  argmin  £  \\si\\2Q.  +  ||vect(r)||£ 

i= 1 

x(t  —  i  +  1)  —  a(x(t  —  i )) 

—Bu(x(t  —  i))  T  +  A (t  —  1)  u(t  —  i)  =  Si,  i  =  1, . 


.,7V 


(13) 


with  Qi  »  R,  i  =  1, . . . ,  TV. 

Step  2:  -  Given  f  (t),  compute  A  (t)  =  A  (t  —  1)  +  f  (t)  and  solve  the  following  CAP 


“(*)  4  argmin  ||s||^  +  INI*, 

Bv(x(t))v(t)  =  Bu(x(t))A(t)u  +  s  (14) 

«e!l 


where  s  G  VJl  is  the  parity  slack  vector  and  Qs  =  Q's  >  0  and  Ru  =  R'u  >  0  consistent  weighting 
matrices.  In  order  to  force  slack  vector  to  be  as  small  as  possible  usually  Qs  »  Ru  is  chosen. 


Remark  1  -  In  all  cases  in  which  a  unique  solution  exists  for  problems  (11),  (12)  and  (13)  an 
analytical  expression  can  easily  be  determined.  This  would  be  beneficial  for  maintaining  low  the 
on-line  numerical  burden  of  the  algorithm.  However,  in  general  one  cannot  ensure  that  a  unique 
solution  it  exists  unless  special  care  in  generating  the  inputs  u(t)  is  taken.  See  e.g.  next  section  3.3. 


3.2  Properties  of  the  two-step  algorithm 

In  this  section  we  will  investigate  the  properties  of  the  proposed  algorithm  with  a  particular  regard 
to  constant  actuator  faults  or  loss  of  effectiveness.  To  this  end,  the  following  fault  at  time  t' 

A (t)  =  I  t  <  t',i  =  l,...,m  .  . 

A(t)  =  A'  t  >  t',  i  =  1, . . . ,  m 

is  assumed  where  A'  =  diag{5[, . . .  5'm}  is  the  a  constant  diagonal  matrix  corresponding  to  the  true 

loss  of  effectiveness. 

In  particular,  we  are  interested  to  study  the  asymptotical  properties  of  the  R-weighted  estimation 
error 

eR(t )  =  ||vect(A(t)  -  A')||ij  (16) 

and  the  conditions  of  its  convergence  to  zero.  It  is  reasonable  in  fact  to  argue  that,  as  many  other 
parameters  estimators,  the  convergence  of  the  proposed  one  strongly  depends  on  the  nature  of  the 
input  signals.  Such  a  dependence,  especially  in  a  closed  loop  embedding,  can  yield  to  partially 
uncorrected  estimations  (see  [14]). 

The  following  result  on  the  monotonicity  of  the  estimation  error  can  be  stated. 

Proposition  1  -  Given  the  overactuated  physical  plant  (8)  and  the  corresponding  virtual  plant 
(3)-(9),  let  the  algorithm  (1 1)-(  12)  perform  under  (15).  Then,  the  weighted  estimation  error  e^(t)  = 
||vect(A(t)  —  A7)||k  is  a  monotonically  non- increasing  sequence,  i.e.  en(t  +  1)  <  eR(f),  Vt  >  t!  +  TV. 
Proof  -  Reported  in  [21],  □ 

Finally,  thanks  to  Proposition  1,  under  a  constant  fault  it  is  possible  to  conclude  that: 

Main  results 
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1  -  As  expected,  in  the  general  case  the  algorithm  does  not  ensure  that  eR(t)  converges  to  zero. 

In  fact,  the  convergence  strictly  depends  on  the  nature  of  the  u(t)  history; 

2  -  Because  e(t)  is  monotonically  non-increasing,  if  3t*  >  t'  +  N  such  that  eR(t*)  =  0  then 

eR(t)  =  0,  Vi  >  t*; 

3  -  A  sufficient  condition  for  e(t)  to  have  zero  value  at  some  finite  time  t*  >  t'  +  N  is  that 

rank{(M (t*)}  =  m,  where 

(Bu(x(t-l))diag{ui(t-l),...,Um(t-l)}  \ 

(17) 

Bu(x(t-N))diag{ui{t-N),...,Um(t-N)}  J 

Proof  -  Reported  in  [21].  □ 

3.3  A  threshold  two-step  algorithm  for  linear  systems 

It  has  been  shown  that  the  proposed  two-step  algorithm  to  the  A-TCAP  does  not  guarantee  the 
convergence  of  the  estimation  error  to  zero  in  general  because  of  possible  rank  deficiency  of  the  M(t) 
matrix.  A  popular  way  to  move  around  this  obstacle  is  by  the  introduction  of  artificial  disturbances 
able  to  force  the  input  signals  to  be  persistently  exciting  the  system.  Those  disturbances  obviously 
cause  unwanted  side  effects  on  the  system  behavior.  Here  we  will  perform  a  different  policy  and  we 
will  exploit  both  parameter  estimator  properties  and  actuator  redundancy  to  reduce  side  effects. 
This  is  made  by  using  the  following  two  key  ideas: 

1-  Because  of  the  monotonicity  of  the  estimation  error,  in  order  to  have  an  exact  estimate  of 
A (t)  is  enough  that  matrix  M(t )  have  full  rank  at  least  for  a  single  time  instant  t* 

2-  It  is  possible  to  exploit  actuator  redundancy  in  order  to  reduce  the  side  effects  of  artificial 
disturbances. 

In  order  to  easily  perform  the  objective  of  having  a  full  rank  M(t),  the  following  sufficient  condition 
for  linear  systems  is  proved. 

Proposition  2  -  Let  Bu(x )  =  Bu  be  a  constant  matrix  and  Buj  ^  0,  j  =  1, . . . ,  m,  denote  the  j-th 
column  of  Bu.  Then  rank{M (t)}  =  m  for  N  =  m  provided  that 

(  /  ui(t  -  1)  ...  um(t  -  1)  \  | 

rank  l  ...  ...  ...  I  >  =  m,  (18) 

[\ui (t-m)  ...  um{t-m)  J  ) 

Proof  -  Reported  in  [21].  □ 

3.4  An  on-line  algorithm 

It  is  possible  then  to  present  the  following  algorithm  in  which  condition  (18)  is  ensured  in  (19)  by 
applying  an  appropriate  perturbation  to  the  allocated  inputs  u(t). 

Init 

/ orceC onvergenceFlag  =  0; 

N  =  0; 

Step  1  -  Residual  generator  and  threshold 

r  =  0 

if  (A  >  0) 
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r  =  x(t)  —  Ax(t  —  1)  —  Bu(A(t  —  1  ))u(t  —  1) 
if  (rT Qr  >  ethr )  AND  ( f  orceC onvergenceFlag  ==  0) 
forceConvergenceFlag  =  1: 

N  =  0; 

if  ( forceConvergenceFlag  ==  1)  AND  (N  ==  m) 
forceConvergenceFlag  =  0; 

Step  2  -  Parameter  Estimation 
Solve  (13) 

Step  3  -  Allocation 
Solve  (14) 


Step  4  -  Adding  Artificial  Disturbances 

if  (forceConvergenceFlag  ==  1) 
uT(t  —  1) 


C0ld 


uT(t  —  N ) 


if  ( Ker{U0id )  *  u(t)  ==  0) 

Solve 


min  5 

s,n 

12 

"Qs 

+  K41 

Bv(x)t 

1  = 

BV(X 

N 

u(t )  = 

£ 

PiU(t 

i= 1 

[oq, ..., 

OLm 

,-n]T 

u  G  12 

m—N 

£  - 

i=  1 


(19) 


If  ( N  <  m ) 

N  =  N  +  1 

goto  Step  1 

where  Q  G  TZn  x n  is  an  appropriate  weighting  matrix  and  ethr  is  an  appropriate  scalar  threshold. 


4  Numerical  Examples 

4.1  Linear  unstable  model 

Consider  the  following  linear  model 

x(t  +  1)  =  Ax(t)  +  BuA(t)u(t) 


(20) 


where  x  G  1Z:i  is  the  state  vector  and  u  =  [111,112,113]  the  physical  input  vector  subject  to  the 
constraints  —5<ut<5  i  =  1, ...,  3.  Matrices  A  and  Bu  are 


A  =  1.2,  Bu=(  1  1  1  )  , 


(21) 


and  Aft)  is  assumed  as 


A (t)  =  diag{  1, 1,1}  t  <  50 

A(f)  =  dioflf{l,l,0}  50  <  t  <  225  (22) 

A(f)  =  diag{l,  0.5, 0}  t  >  225. 

consisting  of  a  sequence  of  two  faults.  The  first  occurring  at  time  A  =  50,  when  the  effectiveness 
of  the  third  actuator  becomes  zero.  This  is  followed,  at  time  t  =  225,  by  a  50%  reduction  of  the 
effectiveness  of  the  second  actuator. 
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State  x1  Using  F-TCAP 


Figure  2:  Output  and  reference  with  (UP)  and  without  (BOTTOM)  F-TCAP. 


The  virtual  input  matrix  Bv  =  1  and  the  virtual  control  law  K  =  —0.6  have  been  chosen.  The 
threshold  two-steps  version  of  the  (F-TCAP)  strategy  was  used  with  parameters:  ethr  =  10~5, 
Q  =  Qi  =  105,  i  =  1, ..,  3,  and  R  =  Ru  =  /3x3. 

Simulation  results  on  plant  evolutions,  actuators’  allocation  and  control  reconfiguration  are 
reported  in  next  figures  3-6  for  a  tracking  problem  from  an  initial  state  x(0)  =  0  and  a  square  wave 
reference  signal. 

In  order  to  show  the  the  effectiveness  of  the  adaptive  strategy,  two  sets  of  simulations  have  been 
accomplished:  with  and  without  the  use  of  the  adaptive  (F-TCAP)  strategy.  When  (F-TCAP) 
is  not  used,  a  CAP  problem  is  solved  at  time  t  =  0  and  the  corresponding  allocation  rule  frozen 
afterwards. 

Figs.  3-5  report  respectively  the  output,  the  physical  and  virtual  input  closed-loop  evolutions 
achieved  with  (UP)  or  without  (BOTTOM)  the  use  of  the  (F-TCAP)  strategy.  In  particular,  in 
Fig.  3  it  is  easy  to  note  the  effectiveness  of  F-TCAP  in  reconfiguring  the  actuators’  allocation  after 
a  fault  occurrence.  Correspondingly,  Figs.  4  and  5  report  the  physical  and  virtual  input  evolutions. 
It  is  worth  noticing  how  signals  related  to  failed  actuators  smartly  change,  coherently  with  the 
new  estimated  actuators  effectiveness.  On  the  contrary,  under  a  frozen  allocation,  all  input  signals 
change  uniformly  and  the  tracking  performance  is  lost.  This  behavior  can  be  better  explained  in 
Fig.  5,  where  the  virtual  inputs  v  are  shown  in  both  cases.  In  the  (UP)  part  is  possible  in  fact 
to  remark  how,  unlike  in  the  (BOTTOM)  part,  the  control  law  behavior  is  not  influenced  by  the 
faulty  events,  apart  around  the  time  instants  of  fault  occurrences,  and  the  steady-state  values  of 
the  control  action  remain  unchanged. 

Finally,  in  Fig.  6  ,  (UP)  the  estimation  error  eu{t)  =  \\Vect{A{t)  —  A(t))||#  and  (BOTTOM) 
the  difference  between  the  desired  total  control  effort  and  the  actual  one,  i.e.  BuA(t)u(t)  —  Bvv(t ) 
are  reported,  both  achieved  under  the  proposed  F-TCAP  algorithm.  Those  are  two  important 
indexes  to  evaluate  the  estimation  and  reconfiguration  performances,  the  lower  the  better  (at  zero 
one  has  exact  estimation  and  allocation).  Notice,  in  particular,  their  finite-time  convergence  to  zero. 
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Input  Signals  Using  F-TCAP 


Figure  3:  Physical  inputs  u(t)  with  (UP)  and  without  (BOTTOM)  F-TCAP. 


Virtual  Input  Signals  Using  F-TCAP 


Figure  4:  Virtual  inputs  v(t)  with  (UP)  and  without  (BOTTOM)  .F-TCAP. 
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Parameter  Estimation  Error 


0.5 


1  1  1  1  1 

 J 

-  BuA(t)u(t)-Bvv(t) 

1  1  1 

;  ; 

1_ 1_ 1_ 1 

0  50  100  150  200  250  300  350  400 

Time  (Steps) 


Figure  5:  (UP)  Parameter  estimation  error  en(t))  and  (BOTTOM)  parity  equation,  viz.  the  gap 
between  obtained  total  effort  BuA(t)u(t)  and  desired  total  effort  Bvv(t) 


4.2  Tracking  of  an  overactuated  autonomous  marine  vessel 


We  consider  the  ship  model  presented  in  [20]  with  actuator  dynamics  discarded  for  simplicity.  In 
this  model  Earth-fixed  positions  (x,  y )  and  yaw  angle  (j)  are  represented  by  the  vector  r]  =  [ x ,  y,  (j)]T 
and  the  body-fixed  velocities  are  expressed  by  v  =  [u,  v,  r]T ,  where  u  is  forward  velocity  (surge),  v  is 
transverse  velocity  (sway)  and  r  is  the  angular  velocity  in  yaw  (rate  of  turn).  In  order  to  normalize 
variables  the  following  bis-scaling  change  of  variables  is  accomplished: 

T]  =  diag{L,  L,  1  }y"  ,  , 

v  =  diag{y/~gL,  y/gL,  yfgL}u" 


where  g  is  the  gravity  acceleration  and  L  the  length  of  the  ship.  Time  was  bis-scaled  too.  The 
resulting  bis-scaled  nonlinear  ship  model  is  as  follows 


=  J(g"(t"))u"(t") 
Mv"  (t")  +  C(u")u"(t")  +  Du"  =  BuA(t")u"(t") 


(24) 


where  u"  =  [u",...,u'q]t  are  the  input  signals  scaled  in  such  a  way  that  \u"\  <  1.  In  particular, 
u"  and  u'2  represent  the  two  identical  main  propellers  whereas  the  other  four  inputs  are  thrusters 
acting  as  rudders.  Moreover,  M  is  the  inertia  matrix  and  C(u)  and  D  matrices  taking  into  account 
Coriolis,  centripetal  and  damping  forces.  Matrix  J  is  the  usual  rotation  matrix  in  yaw 

/  cos(cf>")  —sin(cj)")  0  \ 

=  I  sin(<f> ")  cos((j)")  0  I  .  (25) 

V  0  0  1/ 


In  our  simulation  we  consider  a  supply  vessel  with  mass  m  =  6.4  10 e(Kg)  and  length  L  =  76.2 (m) 
with  the  following  non-dimensional  matrices  [20]: 


/  1.1274  0  0  \ 

M  =  0  1.8902  -0.0744  , 

V  0  -0.0744  0.1278  / 


(26) 
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1.8902u"+0.0744r"  ^ 

(27) 

1.1274m" 

0  ) 

0  \ 

-0.0141  , 

(28) 

0.0568  ) 

0  0  0  \ 
11.6  6.0  6.7 

-4.6  2.7  2.2  J 

(29) 

t  <  72.3 (s, 

, 

C(u")  = 

(  0  0 
=  0  0 
y  1.8902t/'-0.0744r"  -1.1274u" 

0.0414  0 

D"  =  l  0  0.1775 

0  -0.1073 


Bu  =  10 


The  following  fault  occurrences 

A  (t)  =  diag{  1, 1, 1, 1, 1, 1} 

A(t)  =  diag{  1, 1, 1, 1, 1, 0},  72.3(a)  <  t"  <  211.6(a), 

A (t)  =  diag{ 0.5, 1, 1, 1, 1,  0}  t"  >  211.6(a). 

are  considered.  The  first  fault  corresponds  to  the  complete  failure  of  a  thruster.  The 
subsequent  event  is  an  additional  loss  of  effectiveness  of  one  of  the  two  main  propellers.  The 
input  matrix  is  chosen  to  be 


B„  =  10 


and  the  following  back-stepping  control  law  [20] 

Bvv  =  Mvr  +  C(y")vr  -  JT (rj")Kds  -  JT{g")Kvf, 
is  considered  for  the  virtual  plant  where 


(30) 

second 

virtual 


(31) 


(32) 


V 

=  v-m, 

Vr 

=  r]d-  Afj, 

Vr 

=  rid  -  A  [J(rf')v"  - 

Vd]  , 

vr 

=  ')Vr, 

z>r 

II 

1 

SP 

-i 

s 

II 

1 

-3- 

-i 

II 

ST 

5) 

-  7 )r 

Notice  that  rjd,  that  is  the  bis-scaled  reference  trajectory,  is  chosen  in  such  a  way  that  rjd,  rjd,  rjd 
are  smooth  and  bounded.  Finally  k,K^,Kd  are  the  following  design  matrices:  A  =  0. 1/3x3  and 
Kv  =  Kd  =  /3x3- 

The  plant,  the  control  law  and  the  control  allocator  have  been  simulated  with  a  non  dimensional 
virtual  sampling  time  of  h"  =  0.02,  corresponding  to  h  =  0.0557(s)  in  real  time.  Simulation  results 
are  shown  for  an  initial  position  vector  t]q  =  [ — 3,  0,  3/27t]  and  initial  speed  vector  vq  =  [0.01,0,0]. 
To  show  the  effectiveness  of  the  proposed  strategy  this  experiment  has  been  simulated  both  with  the 
proposed  F-TCAP  scheme  and  under  a  fixed  allocation  provided  by  solving  CAP  at  time  t  =  0. 
Fig.  7  shows  the  position  of  the  ship  in  terms  of  Earth-fixed  position  coordinates  x,  y  and  yaw 
angle  (j>,  both  for  the  .F-TCAP  (UP)  and  CAP  (BOTTOM)  cases.  Improvements  can  be  noticed 
in  the  4>  tracking  under  F"-TCAP. 

Figs.  8-9  report  the  physical  and  virtual  commands  related  to  main  propellers  only.  All  other 
commands  have  been  omitted  for  brevity  because  their  changes  are  modest  in  these  experiments. 
In  particular,  Fig.  8  shows  the  physical  commands  u\  and  112  to  the  main  propellers.  Also  in  this 
example,  it  is  possible  to  notice  how  under  F-TCAP  any  single  physical  command  is  reconfigured 
coherently  with  the  fault  event  while  under  CAP  all  signals  change  uniformly,  increasing  their  val¬ 
ues.  This  last  fact  can  be  also  noticed  in  Fig.  9  where  the  single  virtual  input  v\,  representing  the 
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Position  x-y-<j)  using  F-TCAP  and  CAP 


Figure  6:  Ship  Position  in  x  —  y  —  coordinates  and  reference  with  (UP)  and  without  (BOTTOM) 
^-TCAP.The  circles  indicates  fault  events. 


total  effort  provided  by  the  two  propellers,  is  compared  with  the  same  virtual  command  correspond¬ 
ing  to  a  fault-free  experiment.  By  direct  comparisons,  it  is  possible  to  notice  that  under  ^"-TCAP 
the  closed-loop  performance  is  not  substantially  affected  by  the  fault  events.  On  the  contrary,  under 
CAP  only,  a  control  performance  degradation  usually  results.  Finally,  Fig. 10  reports  the  estimation 
error  and  parity  equation  histories:  again  their  finite-time  convergence  to  zero  can  be  observed. 

5  Conclusions 

A  preliminary  adaptive  scheme  to  perform  fault  tolerant  control  allocation  for  nonlinear  discrete¬ 
time  systems  has  been  here  proposed  for  disturbance  free  plats  subject  to  loss  of  effectiveness.  Two 
algorithms  have  been  proposed  and  their  properties  investigated.  The  effectiveness  of  the  proposed 
method  is  shown  by  means  of  two  numerical  experiments.  Extensions  to  more  general  class  of  faults 
and  in  the  presence  of  state  and  measurement  disturbances  are  in  progress. 
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